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(54) WALKING POSTURE GENERATION DEVICE FOR LEG TYPE MOVING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide appropriate Cs^ED 
steps and rotational angles by providing a walking 
posture generation means which performs approximate 
calculation of requirements on the walking attitude 
based on a selected standard walking posture and 
generates an approximate walking posture for satisfying 
the requirements on the walking posture. 
SOLUTION: A standard walking posture data group 
which is prepared on off-line is stored in a ROM 

beforehand (S10). Secondly, an end upper body position | 
and speed of each standard walking posture are found so 

as to be stored (S12). A timer value (t) is set to 0 (S14) pgjr*T^^ - ^ ^ 

so that interruption of the timer is waited (S18). Thirdly, 
a changing point of the walking posture is judged and 
when it is affirmative, the timer is reset (S20) and a 
requirement value to the walking posture is read (S24). 
Fourthly, generation processing of the walking attitude is r , . , 
implemented (S26). Fifthly, the walking posture > h *° 

generation parameter is substituted (S28) for a target 

walking posture parameter and an instantaneous value of the target walking posture is 
calculated (S30). Sixthly, the time (t) is renewed (S32) by At. BothHeg compliance is provided 
based on the walking posture generated thereby, a target joint angle is found, and the robot is 
driven and controlled for the target value. 
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©*P<. Bt^IJt {Ct5C^SZMP©(4g(x,v,z)^* 

r> . 

[0 06 9] ^tc^mmz^^-mMmoxME^ 

^ft^>^ 

^H^fiifc^-r ^{ca^^-^ jt - ^ ^H^^^fg-r 

g( t: a, b, c, d, x(k), y(k)) : MmgiMZMMIr & 

mm 



f( t: a, b, c, d) : ZMP$fciI£faarr SMS* 0*c& 

iB. Is. 

b : trnmrnzw-mims <#*i) 

c : JtW;£f#ffl©ZMP©Xffi*l 
d : «-»3t^W©ZMP©Yffi« 

xck) : ±<*<aa©xffiisp*js?« 

vCk) : ±m&B<DYMHM»X*| 
[0070] CCD^IB-C«, B#3fi5»J4>— $ 

an^. ±tt{4«©B$fc5>j.*5i:g 
.^^se^-r -s >-* ^ ^ - * © <£ -5 «ca -> r t> & „ 

[007 1 ] c©Htt©jB»-Ctt. #JW±{*{i§ • jSR 

aMrflras-rSo 

[0 07 2] C©H^©^{C*JliT««!Si^<b U 
Sl#g5*770tfi!)fPilEltli(is, JWT3 

motifs 

q( t: a0, bO, cO, dO, xO(k) , yO(k)) 
f( t: aO, bO, cO, dO) 

m i mm^ 

q( t: al, bO, cl, dl, xl(k) , yl(k)) 
f( t: al, bO, cl, dl) 

q( t: aO, b2, c2, d2, x2(k), y2(k)) 
fC t: aO, b2, c2, d2) 

[0073] cne.^i$s©»]«»E¥fii • 

St. ^g£*3I-f «ttfi**B(CmT «fc 9 
[0 0 74] 04 7 ^r- h©lftB^{cA-5»Sfr(C. 

[00751 3^. $3$g®^7^-*affl«a 
3. b©ffittb 3-C&£„ *g©*fr%»te-r 



(7) 1 0 -8 6 08 1 

12 

(k). y(k)£in{5J{Cifc£-r 
[0 0 7 6 ] fCt, S3M^ 
q( t: a3, b3, c3, d3, x3(k) , V 3(k)) 
f( t: a3, b3, c3, d3) 

£*s£. J<7jt-Zc3, d3*sJ:a'B#^j7— 7';Ux3(k), 
v3(k)£?&E-r£„ 

[0 0 7 7 ] CCT, fl§»£je*-r*£. 
*3j;0'b«. C©£SgfcW©?i-g|S (*-*<\s-Z<Di>3 -i 
%£©»(£«:.£&) $/c«S'i©$lg (m 
10 3 7"p ? ^S«:*ji < ^ri^W3>7 , 7-i'T>x$ijaJ^ 

[0 07 8 ] C©l5tt©3g»rBttW©lB«<b0fc«). 

mauHa.y&stmi*tiat ©**.ss«:geje 

1) =t-<t/-#rt>6©fiS (J5£[I]#l8*>cfct>'fliilK?§ 
20 ^ 9ft.UaK*&£) 

2) flkOftkUgS (ftiUNMKc£) *»Wfc«£. 
*-tift>6©£$ <flM.ttft£¥fflB* ©fliJ 

3) Binj^v/ifctt^^Pi©*^*^ (ffiw±(* 

[0 079]fnWU dfeJiy'f- 
7*;Ux(k), yCkDOJr^JC, jajgf^A^ - ^©filiClE 

[0080] i fc. mo wm&n\m<nsti 1 & <£ t>*m 2 

(ecru, ft?*—* a £ b ) <Dfa-Ctctct> t 

id#g©«£&s#§ <*o«wi*s) ^-i-x^ifi 

40 Pf^ 0 

[0 0 8 1 3 CCf, S*^g©^>-* (c©W«ffl 
S-C»S*#g©/<7y-i»«: rtg^^^-^f J £6 
#5) ©#aM7£|&<«-r6£. 86M^'9^-fc3, d3fc 
JcO'ge^Bf^Jr— ■T'^UxSCk), y3(k)«. t,^n&. ^ 
«f©*ff*«fc-J-fcAK. jftSHase^^^-^aibK 
JC&cr^fcf-S. -'^y-^a£b©^{t{c*t 

it. cn6©fB«jS^e < ]«caffc-rs^©£#x.6n 
s,, -?-cr-j^Ttc^-5i5ftuia*ftjffl-rsc£^r'^ 

50 So Hl%. ia<K?H@ ; &tf'5C£fCJ:fpM*^©^-7^ 



(8) ftfflW- 1 0 -8 6 0 8 1 

13 14 
-ZZ&tb&Ct&VZ&o * * [0 0 8 2 ] n»RW»6^«:a5«»Bar**tt6li. 

P(a0+Aa, bO+Ab) = P(aO, bO) + SP/Sal (a=aO,b=bO)* Aa + 8? 
/8b\ (a=aO,b=bO) *Ab- • • ififK^ 1 



+ C d2 
x3(k) = xO(k) 
/ ( al - aO ) 
( b2 - bO ) 
V3(k) = yO(k) 
/ ( al - aO ) 
C b2 - bO ) 

[0 08 8] JbtE<D5£ 1 « 



dO ) * ( b3 - bO ) / ( b2 - bO ) 
+ ( xl(k) - xO(k) ) * ( a3 - aO ) 
( x2(k) - xO(k) ) *( b3 - bO ) / 



20 



8P /Sal Ca=aO t b=bO) : a=aO,b=bor(DP(DaCCBa-r€> 
8P /8b\ Ca=aO,b=bO) : a=aO,b=bOT'<DP<DbCCM'r& 
[0 08 3] E&t, 

8P /Sal (a=aO,b=bO) = ( P(aO+ Aal, bO) - P(a 10 
0, bO) ) / Aal 

8P /8b \ (a=aO,b=bO) = ( P(aO, bO+ Ab2) - P(a 

0, bO) ) / Ab2 

t*50-C, ifilHS;i « 

P(aO+Aa, bO+Ab) = P(a0, bO) 

+ ( P(aO+Aal, bO) - P(aO, bO) )/ Aal* A a 

+ ( P(aO, bO+Ab2) - P(aO, bO) )/Ab2*Ab 

• • -mm2 

[0 08 5] m^^<D^? j* - %<Dl£&^<Dmft*m 

v&±, m*mcmxr(D^<D& 5 ic±x commas 
tebtmmmc & & t m*. z> c t % s e> r * 

[0086] a 3 ^ a 1 i a 2 ©rtOTCC*ft tf 
#<5 —SB©'* — SB<DB*^Jf— 

r-s«:H-j|t-r5 4»i<o«»*a8 ooti^^i 
[oo87] ^r^um^^-^^^um^-^^ 

<DUtt <rt#*fcttfl^K:j:4) £^-r < arc cos 

c3 = cO + ( cl - cO ) * ( a3 - aO ) / ( al - aO ) 
+ C c2 - cO ) * ( b3 - bO ) / ( b2 - bO ) 
d3 = dO + C dl - dO ) * ( a3 - aO ) / ( al - aO ) 



30 



40 



+ ( yl(k) - yO(k) ) * ( a3 - aO ) 
( V 2(k) - yO(k) ) *( b3 - bO ) / 



&mm'iU-2to£V7- 50 



c3 = ( 1 - ( a3 - aO ) / ( al - aO ) - ( b3 - bO 
) / C b2 - bO ) ) *c0+ ( a3 - aO ) / ( al - aO 
)*cl+ ( b3 - bO ) / ( b2 - bO )* c2 

t & 9 , cO<b cl<h c2(D ffi&<Dft\*S HOSotC^ <D~C , 

c3«, co<bci^ c2 cc*frss**5-en-en 

( 1 - ( a3 - aO ) / ( al - aO ) - ( b3 - bO ) / 

C b2 - bO ) ) 

( a3 - aO ) / ( al - aO ) 

C b3 - bO ) / ( b2 - bO ) 

[0 0 8 9 ]^ ^ffi±»(4g ■ m&bs.mm£'^s 

[0 0 9 0 ] *fc±«ffl«*»jfiWf t --^*63|M>* 

o*j6©»«-c«nsj:^*c. !tt*?i»rzMPa:S 

[0 0 9 1 ] $/cC<D&*, l**ftSTSfc»5C», 

[0 0 9 2 ] ±IBCD^^cJ:oril^S(Z)^ , v^-^ 

[0 0 9 3 ] WT, @47P-' *i*-h£#JSOTC 
U/cmriESm^ScD^- R OM 8 4 Cc^abiatBS 

[0 0 9 4 ] 5fc&c2Wfcitl< % ±{£2 4CD{aS#KI»x 

ck),v(k) ^L/r^-^Mtsnrc^cor, iia«f- 

[0 09 5]^l>t, S 1 4&CitA,r£-Yvffit ^0 t 

u ( h , s l 6*igr s i stcil 
v»0ii#«fSo (S 1 4©>^7ittatt 



(9) 

15 

5) „ 04©7CJ- • ? + - RifflxJ*. 20msCi 
lCl&$h2tl2>o EP^. iHSPJaJtli» 2 Oms CtX$>&. 

[0096] ^^-es 2 Oic^r^so^jo^fj 
a. Sf*ftic«i£©^9Sfc>9BT-*s^57M« 

» h 0. s 2 4 K^ribgcc*r-r4B*iB (jlf&Wcc 

a . b ) 

[0 09 7] ^>tS 2 6 lcmA,T?t&®<Dm&!lBM>&tf 
*><, 10 
[ 0 0 9 8 ] 13 1 4itt<Di'mifn-r^zf^-^> ■ V 

[0099] sfe-r. s i o oic*s(.>xm.mmm>i5ji- 

Hi 5*#JROTB«IT*&. a»B3E^9>- 
Sa, b©fil#g#ffl 3$§) ©a3, b 3 CCjfiC> 

[0100] XMS 1 0 2fc&A/C_kiB©BJSa9Se/< 

^y-*©fiuc&.5^<ia< . s/c -etna, -t-^ 
M©«7y - jrit£«o!>Mito/-(9 x - $ momcm 

[o i o i ] ft. f^r»5©nsgo^-eai'>t.2 > cfc^ 

[0102] fifot. |&8&M£¥&K • sSI^^- 

for, ijfiBaif»ja¥ta«-ss»A7y-*A;w*^- 

*#Si»tt*#g*«^©fcfc{cjB«TSsflBfc& 40 

[0 103]^1>TS10 4{C^-Cig^S©igSt9: 
S^y-£CCg:£<8£ftAU S 1 0 6 tC^TMiB 
©>^y-*#tij5£ (Si ) K:j;0tli^g©S£jg^7 

[0 104] a4«:R^i. it,>TS 2 8«Cj8A/CiB£ 
(t— (f- 
(CftAU S 3 0 (CiI^Stt$@©RI$fB 

(^siwiwja*!o«§) *atnrra. 

[0105101 7«-€-(Df / P*?r^-r^7';U-^> • 7 50 



»H¥ 1 0 -86 08 1 
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[0 106]5fcf. S 2 0 OK.te^xm&i&^vJ-- 
*itS^rB$2lJt©ZMP£5j<«t>. S2 0 2KMr 

[0107] j&l»T S 2 0 4CCjiA-CB#^J t <DMJ£¥& 
B • =£19 i ®fM t - A t ©±{i{*7MPtig> 6B#SU t © 
±&»53 (SO. ^©fftiffl«5fclc&j$^fc: < fc < >K: 

[0108] i^tS2 o 6<,cmA,xmiRLtcmm&n 
(-i-x^^t?) ©B$m©±f*{as&ca-3i>r$fccc 

[0109] fo>t047D- •?t-KOS32KR 
•5-C^Jt*AtA:WM59fO« S 1 8 (Cg|oT±§S©M 

[0 1 1 0 ] ft. ±t2©in< LT£E£Ufc*#g{cS-3t,> 
[0 1 1 1 ] Hi 87 n— • ?- + -h£#asi/-CMW=i 

3 o o rs«3>77 -rr^^ai^fid^ststis. 
[oi i 2 ] 0 1 9 <,i^<Di^m^rv^)v-^> ■ y 

P- • + - hr-&<9 . S 4 0 OCCfcC^T 6tt^7-fe>tf 
4 4 ©tfcttifil£^.&i£#. S 4 0 2 CCBATfcattfr 6 

zMPommiiLm (mm%.t><p'b£L) s 4 0 4 
«c»^zMPB«ttB±itt8i/-caBg. bp*>. -rn^ 
[6ifc<fco*-rnsx*5i?to, s 4 0 6 kma,-?^©^ 

fo T£¥©ifFi4**, S 4 0 8 KitA,-Cpf JE¥© 

a«taaE-se»**a>fc!ft^BK:j£i;rre-r. ft. ji 

Z M P (4B i WfELh 4>'C\*«— SrT -S fee* . C <DWM 

mximmtLxt&s. 

[0 1 1 33 HI 870- • ^f-hCCRSi. ^l^-C 

s 3 0 2 <cjix/?fi¥ffiB • (3>7'7-rr>x$ij 
i^ca^T&*o©il**v7-., i/xjU^^/rLr 1 2 

<@©B8gii©g*fl#K£lltU S 3 0 4 (C®A-Cffi$4"fe 

sewBT s . c n»n*«KBS 2 <Dmmmm 8 2 aqf 
[01 14] c©nis©»«t*±e©fti<*RRofc© 

^IsIft^liai-r-Sci^-Ct^. MCctt. 'jT^^-r 



(10) 

17 

[ 0 1 1 5 ] <fc 0»O< ». t&m^tfclBlfHlC-o^TKDli 

M<Dm*tczt l x tats <* n fegso^otim^^ 6 * - 
re. wfe. BfrieofciaMafic^'fT^ cite iD. mriab 

[0116] EK«±ie©£n< tSl&G/cC £#>£. ft» 

SfcWSWtitf) K#©«**fc@l3J±£ 

■TSCiJCiO. *ft6©tflfflWft*fr£*ffiS;K£JiR-r 10 

[01 17] £ fc. ±SB<D*P< »«UA:C £-C8SJWt* 
(SM-TSC WtWKtt. 'Jr^f-YAtC^ 

•ft^x^K ©{c jt^rsi i ©<Hfs^H 8 o omn 

wtfii/i omBuci&m-rz. ®c. 

iatgL.rte#. **i6*«£iyT**g*:£jsR-r*©'T?. 

(ROM8 4) ©Sfi^fijSS-fi'SCi^rt 
£. SiStt*^S-r^©r. ^1) ^6 5) £ 

-c*-5. 20 

[0118] 02 Ott. C©»W©*2©SI»©JB!B* 
[0119] ^2©j|Sfe©0SgCC4BC»-C« < «!**£§£ 
fc. rjBKj «. ^XT-A©ttj^^1$ttj!>iA* J ?>^'7^ 
Ste***** 1 . IS 2 ©3li6©JB»Kfel >Ttt**#S 

[0120] cfcojuwtyuj. ifc^-c^- 

£) WMiifciSK, *©*S3ft«a*ut>»ni 
a^£ a s fc*(c». fife©a&sw&>'< 5 y - £ftft: 

Sfi-tSR-r-So 40 

[0121] -e©*Slil£L,T. *2©3Ufi©f^«:fc^ 
■C««HS*S©ffl»«r<fi«0. ^-^^£^.5.4>©/c 

-a©,m^L,/c^-x^s©?>j^ £&mmt& 

[0122] *<*fcj{C». £b-5^Sg#§i {Cfc|,>r^5 
y-* ptC*t-r-2>M-^^-$qCD.®jS?rDi (q,p) £IB 



1 0-86 08 1 

IS 

k#a7 r -^x(k)©.®@[5rDi (x(k),p) £iej£-rS<, 
[0123] »2©*fe©ff#S&C:teW£g^g©£jiK 

[0124] $t©m0M**^5C*sW^^-7^-^a(C 
Mt^^j'-fcOSiaDoCc, a) &££. *U 
»*S4©M»». fclT©<fc5tCfc*. (ai - a0) #H- 

D0(c ,a ) = (cl - cO) / (al - aO) 

D0( d ,a ) = (cfl. - dO) / (al - aO) 

D0( x(k) ,a ) = (xl(k) - x0(k) ) / (al - aO) 

D0( y(k) ,a ) = (yl(k) - v0(k) ) / (al - aO) 

[0125] mmic »o«B»*sp«:*»w4^^^-ir 

biC*t-r£^7J<-* cO)SBD0(c, b) &££, Iff 
2tS«£§£©H8<£«, «T©J:5fc:fc*. (b2 - bO) 

D0(c ,b) = (c2 - cO) / (b2 - bO) 

D0( d ,b) = (d2 - dO) / (b2 - bO) 

D0( x(k) ,b) = (x2(k) - xO(k) ) / (b2 - bO) 

D0( y(k) ,b) = ( V 2(k) - yO(k) ) / (b2 - bO) 

[0126111 ©JUt©ftflt©''<?.rf--» teJzVr— 
l"5£2 j £(,>0) 

[ 0 1 2 7 ] c3 = cO + D0( c,a )* ( a3 - aO ) 

+ D0( c,b )*( b3 - bO ) 
d3 = dO + D0( d,a )*( a3 - aO ) + D0( d,b 

) * ( b3 - bO ) 
x3(k) = xO(k) + D0( x(k) ,a )>k ( a3 - aO )+ D 
0( x(k) ,b )*( b3 - bO ) 

y3(k) = yO(k) + D0( y(k) ,a )* ( a3 - aO )+ D 
0( V(k) ,b )* ( b3 - bO ) 

[0 128] ±H^mmi:OXm20 70- • ^-f-h 
*mMLTmffl-?Z>t. S500(CfcC>T + 77^>T 

ftm u tc ^ - x *£g t < =7 jt - $ fm. * late o r *j 

S5 0 2A>6S5 1 4Srmi©^iS©Jf$*Sg<t(51« 

©^s*tfo-cs5 1 6icji^, *#g©ffl£#yii£?? 

[0 1 2 9 ] 02 1 {i-e©fP*^fif7'Jl/-?> • 7 
n- • ^ + - h"C*»3. S60 0tS«^A7^-i! 

©ffi#g#ffi&cific^-x#;g*iai>?u s 6 0 21cm 
s 6 0 4 ^c3i^■cs; 2 ctee r een^- 5- * - s 

So ±<**¥(4S©B#^J^-^;i/«-aJci+fitL. 

[0 1 30] 02OCCK f 3. S 5 1 8*ScfcO'S 5 I 0€r 

s-cs 5 2 o^ca^•ess^©PB#ffil ; &#^il•r■5». 



(11) 
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[0131] m22it^r<Di^m^7fk-rV^)U-9-> ■ 7 
&B • 35»*Hiar5. ft. S7 0 6tttS2©«© 

x. y«ci«-r*s:{caeor±tMc 3 iMaB*Kcm-rs. *t 

^X1M2 Oicm-yXS 5 2 2£HrS 5 0 8KRoTtt 

_h©a&ffl**g«3iE-r. 

[ 0 1 3 2 ] »2©3Stt©fB»«-k8S©*l< AUSOfcC 

tti>t>. mi <om&<Djm t ra«©a»**» * c t #r 

10 

[ 0 1 3 3 ] flU Ktt?£tttt$$©tt£-tf4>ttti**& 
^©teKtCfcoTtt* ^i<DHfig©^cc*t-r-5>^2© 

tc#or*4IH«KHc«IMfcU M-v^-*gg|IBF«iCc« 

(aM/'C9y~jr) ©fB*a*lA>#Stcfc*J:5 20 
[0 134] C©<fc9K0Tn;fiEbfc«iS*#g*8F-3r 

Mt-fct-^^-^iCttLT-e-© 1 -otcV&mte&WM 

[0 1 3 5 ] ft. »2©HSfi©^Sg{C*j(,i-C < I£I5B© 
#§KttLT^y-*®it^^u>t§£tera:> l 30 
o l o©*fcg(c*f Ot ;S5> - £jSS£8FO©TW:& 

<. iA®ffl©^^c*j^r^-rn(3f^i\ c^-rti 

(ROM8 4) ©^*=&©#tj-rsci*s-C 

[0136] D0(c, a), Dl(c, a),D2(c, 

a) ,...DnCc, a) »H5tSft— fiT&&&6 « . ^-©¥ 
fejfif^DCc, a)iL/-C. Jbfa©^.* -*JS6/£:ffl<,>fc 
^7y-^^tC*jW5D0(c, a),Dl(c, a),.. ©ft 
*Df3tCD(c, a)**a«:«A«at». 40 

[0137] 02 3«C©^©^3©HSfi©0SS*^n 

[0138] ^3©SUS©^{C*i^rtt. IS 1 ©JlSfi 
©»»£|SI«©*IWI*S«:fflt»4i*{c. 3I2©J|J&S© 

[0139] m3<D^M<D&m< l C*sV2>m3ti&®<D£.f8. 

[0140] »3©*«6©^»{c*jt»-r». g£Hi^y 
»*. -SP«^ 1 ©^S6©ff5.eg©#af . J^0«^2© 50 



1$gfi¥ 10-8608 1 
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je5fe©ff^©^&£ffl(,>-C*£>.2>„ BP*?. ^S©^ 
4. < 5 ^ - 2 /SgK «fc £ 81 ^©filll?* WfflT £ 

[0141] (TflxJi. fi&f^A^-^rtOa©!* 

«K»Lr»ai i <Dmm<Djtm. b ©f^cstu-ctiis 

2©HJ5£©ffJ8g©#£ ; £:ffll>&<t, #;£©J: 

c3 = c0+ ( cl - cO ) * ( a3 - aO ) / ( al - aO ) 

+ D0( c,b )* ( b3 - bO ) 
d3 = d0+(dl-d0) * C a3 - aO ) / (al-a0) 
+ D0( d,b )*c b3 - bO ) 

x3(k) = xOCk) + C xl(k) - xOCk) ) * C a3 - aO ) 
/ ( al - aO ) + DOC xCk) ,b )*C b3 - bo ) 
y3Ck) = yOCk) + C VlCk) - vOCk) ) * C a3 - aO ) 
/ C al - aO ) + DOC vCk) ,b )*C b3 - bO ) 
[0l42]i2 3 4#ittP^1'5i. S8 0 0CC 

*j t » r * y => ■< > vftffc u 4 - * 

jss*iEte u s 8 o 2 mm m/^x-m i (Dmmmm 

4|SHi©Mffi ; S:tTl>. S8l6*ie>@247D--?t 
- McjIA/CS 9 0 0«BKteli>T#3M>fi-&*ff i 5. 
£/c02 37Q-' ?t-KOS82 0A^|2 57a 

-•^t-hosioo o«»ccjtA-cweii*»ffir 

'So 

[0 l 4 3 ] m3©HSg©^SS«±IB©*P<«^UfcC 
[0144] S 2 6«C©#6W©»4©*te©^SS*7n 

[0145] mm&gtohnzti (m*t£ 

S) Hfcttt. ^2 7(c*r<rSn< . tm*stmc*sl-t Z±# 
©»JS±#ffiB • ilR%^©S^*S©t5»!±*WaB • 

icutc. hp 5. tm±»&A ■ &&*s*amm±#ti[M 
co i 4 6 ] *©*ffi*»»-r-5<b. ;5fc-rsjn &t,>om 

3©*»©»J»©#ffi«rffll»-C. *7J38±t*{ig • ilgfc 

[0147] ffi¥omwimm®mfa<i>Bi&tmm-c2> 

[0148] ffri$©#££)£^&{c:te<,>T. |7JW±(*(4 
[0 14 9] C©»^. WW±f*{iB • 2giZMPA 
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K*ffi*K:a93rf SfcfcJctt. Z MP A£->«-e*Uc 

[0150] fcJTTtt. W4ffi#tctS/cJ0K±(t© 
mf^^rfS] (X#ft) ©WW»**#*.*C£4-r*i. 10 

M P / < * - > CC 2 fflfeLk© ** =y jt - it fiwrnxfr £ . 

[0151] ccttt, zmpa-7^-^o- a54*>-r 

8©«fc0«:^-rs. 

[0 152] CtliJ. ^HU©H)5S©^-Cfflt^ZMP 

6. S£Hif©HS6©^S|-Cffll^©<i:|5l^©ZMP^-^- 20 
±&©iiv«:^©{4K£iS&©ffl;££|sJ 

«F«c«ia3-esfcji>«:B, ^-^^-^ c«^(cs¥mis 
(ciJ^-^A^t^ra©^*^^-"^ t 2 &^ho&< r 

[0 15 3] ^©MfeDJfcagtefct^TZMPA^- 

mw>-rti<D^m&m^xb~ajmx$>2>&, cctai 

2 ©HJ&©Jf2!©#£££Rffl l/rZMP^7^-* ©J§ 

fc„ (S9 % ZMP^y-*©*!**. iB^#g©±f* 

^ - 5? icM Z- ZMjEmZMm-? z . 
[ 0 1 5 4 ] 02 B.*#JHOr»4©!S»©J$S©«lft5 

s i i o o fc*ji»rstij©jU6©^£ 

s i i o 2 K^-e&ii «w£;g©^Jis±&{&g - mm. 
£#tf>rfeti:ofcf£, s i i o 4 tca^-cfciToa&ffl* 

[0 15 5]5tf, g^giCtel>tZMP/<7^-^ 40 
c CC#@ U Cfl£0 2 9 (C^tJ; 5 CCA c ftiWgfc/MS 

[0156] C©£#. 
Rmix(x(k),c ) = Ax(k)/Ac 

C©Rmix(x(k), c)£ c Kl^H" SxCk)©<!{»# 

aa«flt <nrie*S'<5y-i»jssstcffl3) mm 

iC, 03 0 tC^T «fc 5 CC, ZMPA7^-$ etCMLr 
RmixCx(k) , e )3r5fc«>£„ 

[0157] ffJ2©Jtte©7f^«C*st,>-t«, *&aSl, 50 
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fe«7^-5i (t>tf-f § x(k)©i&g£5fctf> & i # «c , ittjifo 

J-Zt x(k)£|£< a^r©t^|S^-7 ^ - £ *W$& Utc. 
•etitcMbt. Sl4©f(aiM>J&«-ctt. *fc;g©Sjltt£ 
MVL LX . ffi@Uc^7>-$i x(k)£J£ < £T ©^ 7 

«. SI2 ©*«fi©^^«giS14?:Sll^fr(C Lfc£* 

©ntfe©^]»»*9tt«Ma ofc^es^*** 

[0 158]*tCSl 1 0 6(CjI«^ Rnrix(x(k), c)<t 
Rmix(x(k), e)©*?S£-e©jlm)©<ii^6 > M^^C 
W5ZMPA7^-$c CC*tT StetiLkftttB©flfK 
^iSSRmixCXe, c). »W±.#mB£.<Dl)3&lfMfJie&R 
mix(Ve, c)> ZMP^7^-$ e CC>tf-r &ii&is&±f*fAg 
©fla^WJBlSRmxOfe, e). ««Lh»iSlS©fl3»^ 
)^KRnrix(Ve, e)£:&5tyC<fc -> T5j?#>& 0 

[0159] Rmix(Xe, c )= RnrixCx(ke) , c ) 
RmixC/e, c ) = (Rmix(x(ke) , c ) -Rmix(x(ke-1) , c )) 

/ At 

Rmix(Xe, e )= Rmix(x(kG) , e ) 

Rmix(Ve, e )= (Rmix(x(ke), e ) - Rmix(x(ke-1) , 

e)) /At 

<su ke : mmm<DM&<D&&mn. At :mmm<Dm 

[0160] 'X^VS 1108 5Cjt#. *isbfc!Sg^e. 
Sdl^lWoaSRaWRnrixCXe, c). SSI 1 f fl& 2 ?lj©g 
^Rmix(Xe, e). 312'ff^l 1 ?iJ©B3K#*Rnrix(Ve, 
c) . 0 2 tfgf 2 ^J©^** R mi x(Ve , e)© 2*2 tf #J £ 

[0161] ^>-CS 1 1 1 OicMArmSL^cfT^J© 

i^ff ?ij**«&<5. c (D^mmom 1 tf m 1 m<Dmm*. 

»4»±*ti«Xe (C*fT*^9y-3rc©«fflk»fl««»ft 
RmixCc, Xe). Ht2tf3l 1 ?ij©g*«. *^4S±(*fegX 
e CCft-TS^y-* eOii^WSSRmixCe, Xe)> 
JBltf»2J>J©B*tt. *S«Lh#affiVe 
^-^c©(g^W.®SRmix(c, Ve). ^2tf^2?iJ© 

SSS«. »4SLh»affiVe cc^-r-s^^y-f e©«« 

^W^SRmix(e, Ve)£-rS D 
[0 1 6 2 ] l^. *e.«5>SjS^*^CCteC>r±IHJa5ffi*i 

tlR(c, Xe),R(e, Xe),R(c, Ve),R(e, Ve) <t L/T. 

[0163] ^tS 1 1 1 2 icmAs-CM^t&^Cte^ 

f*^^S-T 5 J: 5 ecittffiB©!!***!^- ^©m«J7>A 

xCk)4*S>* 0 

Ax(0)= AxO 

[0164] C©£#. 
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RmixCxCk), xO) = Ax(k)/AxO 

*Av0tcVW^mm2-&, RmixCxCk), v0)£*£>£ o 
[ 0 1 6 5 ] 1 1 1 4tCjI<^ #&/cSKRmix 

(x(k) f xO) <b RmixCxCk), vO) <Dfe%ii±^<D\£M<Dm 

«±(*(4gO(@SS^W^SRmix(Xe, xO) , tm±#& 
&<D<ffi8#WSfiRnrix(Ve t xO) , *nffl±<*iiSK:*tT 
^>j^^±^f4g^(@^WSSRmix(Xe, vO) , «49± 
<*ilfiOlia^W«5ffiRmix(Ve, vO) £#:SCK:<fc oT3|c 10 

[0166] RmixCXe, xO) = Rmix(x(ke) , xO) 
Rmix(Ve, xO) = (Rmix(xCke) , xO) - Rmix(x(ke-1) , 
xO)) / A t 

Rmix(Xe, vO) = Rmix(x(ke) , vO) 

RmixCVe, vO) = (Rmix(x(ke) , vO) - Rmix(x(ke-1) , 

vO)) /At 

<iu ke : mmm<D&m<Dmnm^ At -.mmmm 

[0167] m>r S 1 1 1 6 &cjtA,r # A 0 IC U 20 
•fe? bLXAZ- b 31* S 1 1 1 S 1 1 2 0 

*C«^*^v«gi£#*f3«U S 1 1 2 2CCiflA/T? 

*»s i i 2 4&cii^£^v£o&cy-te* 

tSll 2 6CC«^ce»ia3e^9y-dfOS*««:tt 
#iiJ*K S 1 1 2 8 tC^r*S(DS^*tf 5 0 
[0168] g[l^, 0331f^;l/-^> • • * + 

— h CDS 1 2 0 O^CMtSl ^l^f 3 

c<omc vm±&®m- ms.^^m^w&M-m 30 

[0169] fflU ^-X^*attRl/fc«. fiJBUJhf* 

[0170] xws 1202 ecj^r*n»±i*{ft« • 

cn4AXe,AVeit-5 0 40 
[0171] »^'S 1 2 04 5Cit*. S^^CCteC^ 

4B±(*ft« • ilgOBfttSAXse, A VseS^SCCCj: 0 

AX se= Rmix(Xe, xO)*AxO+ RmixCXe, vO)*AvO 
AVse= RmixCVe, xO)* A x 0+ RmixCVe, vO)*A 
vO 

[0172] S 1 2 0 4<D&m*. WRLhttffig • ilS 50 
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ai,Tir>*a*. »»±{*GBR • au££$tt 

iCCD*S©«tt±ftfij« AXe+A 
Xse, AVe+AVser^^ e * C "C S 1 2 0 6 Kit 

-eoM4occ-r*/c«i>(DZMP/>'^y-$cDtijEa: 
Ac, Ae**a{ci-5r*af)S. 

Ac =RmixCc , Xe)*(AXe +AXse)+ RmixCc , 
Ve)*CAVe + AVse) 

Ae =RmixCe , Xe)*CAXe + AXse) + RmixCe , 
Ve)*CAVe +AVse) 

[0173] ^TS 1 2 0 8 &CjIA,rZMP^"-7^- 
*c, e*-XS:cc<fc^r*«)S. 
c = c mix+ A c 
e = emix+ A e 

fSU cmix:il^^S^^^y-^ cCDffl, emixriE^ 
[0 174]^^rH267n--^t-KCR0, S 

l l 3 0(c^-cg«$Sf^^-7^-iftc±i2ig^gf 

eCC«, S 1 2 0 8TWcMftAt5. 3tt>rS 1 

i 2 2*«rs 1 1 3 2tcMA,-cm&&n<Dmmm*n 

{ 0 1 7 5 ] Mf*K>CC«\ i34t^l/-f>^D- 

* 7-1*- HCDS 1 3 0 0CC^rtSMcDj|ffi(7)^i|lI 
«Q*ffirB$3flt©ZMP*#», S 1 3 0 2(CMt 

♦ s 1 3 o 4 fcit^a^soifttaa 

xCk) =xmixCx) + RmixCxCk) ,c) *Ac+RmixCx 
Ck) ,e) * Ae+ RmixCxCk) ,xO)* A x0+ RmixCxCk) f v0) 
*AvO 

{IU xmixCx) rig^^cDif^ftilBt^fJCDkS^- 

[0176] ±8Sl/fc«HlCCJ:^'rAftWCC«ia2 7*j 
cfcO'02 9%^li3 2{C^T&^*®ta^btf£C£ 
-tn«:J:DB|3 5Cc^rJ:5CC k arsosw* 

c<0, c+Ac<0, e<0, e+Ae>0 
tLtc a 

[0177] »4©HH©*««JJBflMBI< «^cUfc<D 

[0178] H3 6ttCO*WO*5©*JS<D»J»*^ 
[0179] jfc<D»4<DHtfi©^98r«, fi^fcSKfc 
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#ffJJeRKRnrix(x(k), c)> ZMP^^-ji eCCxtr* 
±f*ftgB#^J©{IS&#lfl.®gRmix(x(k), e). fiJJWi 

(*(4gKM-r^»±<*agB$^ ? ij© 11 ^ : j). WS j i g Rmix(:x 
(k), xo) . ?^»3±{*jigK^-r?,±(*aaB#s?>j©<s 

SS^WJSaRmix(xCk), vO) 4/Bt>ri,>fc. -g^tf. Z 
CO 18 0] fff5©HSS©lf5!i§r«, 4©tt*>9«:. « 

Tcstisnsn^s- vomm^mnti^'f^ <z 

#4 gsfcfilK-S: $ -s £ «t 5 ft o fc. 

[oi8i] wtk, c©#ffi©»*:jaa*8iwr*. 

(86. «T©»f«rtt±«EiS|biZMPiUB©lir»*lSi 

[0182] D^>n ©±f*2 4©a«*^ntw© 
mm. flp%. SEmttr**?**!*. ^^^^3 7-c 

<« CCtf^KiotB^^ 2 a 4>^a)jgfiEr& 
S. 

[0 18 3] dxmcfl/dt=v 
dvmdl/dt = coO* (xmdl - ZMPmdl) 

Sd^©i*ast * . $ fc a) o}iiE©^^r* * «) . 

±flc»W*3 h *} J: O'S^flnilS s <t 

O 0 30 
a)0=V~ (g /h) 

[0184] ±ia$*^)Wsfcfi^rt>s»^(ctt. m 

Rmix(x(k), c), Rmix(x(k), e), Rmix(x(k), x0),R 
mix(x(k), v0)©tt*>«nc> IMLtcm&fflilM**:'? 
rt<4JB<,>-£c£#r#&. izm. tfJWOWBKD&SZ 
tC, B#^J t 493*nOfcU*§-&fc:W:. 
xmdl(t) , vmdl(t) 
£ SUETS. 

[0 1 8 5 ] ±fB£iiuffi£l,TS3 6 7C- • + - h 40 
«r#MLr^-rS„ ft, ZMPA-$->©ii§tt, Sfl 

4 ©siss©^ £ isi— ec-r & . 

[0186] 5fe-r, S 1 4 0 0 CCfcC^-CSHI^SSrfetS 
O-Cfct. S 1 4 0 2 tcMA,V&Wmi&®<Dtm±.#tiL 

5 • jUK43fc*rfBtt Gfc^ S 1 4 0 4 (Cjtt*. Z M 
Pn'7^-5©rtrcieic=l, e = 0. Sfcp 
(113 5 (Ctt-T cfc^CC^JO^fcWSZMP©^) = 

o, -e©fte©jT*r-©ZMP©fii4o. flj8!tRS§4xo= 
o, vo=oii/. ^©^B$^j$r^sb®j^*^;u 
©Pi&4fU?u teiS^ef^Kiaxe. ^^exjujiffive so 
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[0187] H&ffjCCtt. 02 9(C:tett£Ac4 1 tctft 
JS L fc <!: IT © A c &C J: £ Z M P 2 - >ffiIEfi4 *7%»U 
A^iL/r^^JU©^*^. *?ou|*iitt»*#*>. 
> r Z M P ' 7 - £ c tC*tT 7 s JKigXe© 

R(Xe,c ) = Xe 

[0188] PUfJCZMP^y-* ctcM-TZ&ffi*: 
R(Ve,c ) = Ve 

[ 0 1 8 9 3 (Sj. }S8&lfc^*5^©;p«il©ltlS«. ■=& 

^ftHMStfburj&iejS^iilJIcc <fc o r**r 4>&i> 

[0 1 9 0 ] *1>7S 1 4 0 6&Cit<&. ZMP^7^- 
?©rtTcie?:c=0. e=l. £fcp = 0. •€-©[& 
©*T*r©ZMP©fa<&0 . l7JRl!t#84xO= 0, v0=0 

at, ^©*^B#^jsr. mmmti^^JKDmm 

4ltHU ^-t-r^&SXe. J*JlKef ! JbS.aVe*#«> 
£. 

[0191] ^(.irZMP^-^y-^eJc^f-r-S^iS* 
R(Xe,e) = Xe 

[0192] PIS(CZMP^^y-^e(C*f-r*^* 
^jSKCDflafR^WJSSS^^aK J: ^ r So 
R(Ve, e ) = Ve 

[0 1 9 3 ] :Ja>rS 1 4 0 8CCjI<&. ZMPa-7^- 
$©ftt?cie^c = 0, e = 0, £fcp = 0. -€-©{fe 
©Jf*TOZMPOi?r0, mJBt8K*xO= 1, v0= 0 

lt»U ^iss^T^ufcigxe. *S«S]*? t ;uaK\fe*#«> 

S. 

[0194] ^rffl^f^&gxoccft-r S^Jffi*^ 
;H48Sxe©aB«»»J5$fl[ 4^S«: «fc ■» r*«6 S. 
R(Xe, x0) = Xe 

[0195] ftttCC. fflW*7^U{igx«C#-f Sj^ijg* 
f r ;i'jISve©[ieS^fl < J!SlK4^(c J; -5 r 3iitoZ> . 

R(Ve, x0) = Ve 

[0 1 9 6 ] :*(>rS 1 4 1 OJtjt^ ZMP'<7^<- 
S(f)fttc £ e4c = 0, e = 0, $fcp = 0. -?-©ffe 
©JT.^r©ZMP©fii40. &MWtf3*4xo= 0, vo= 1 

ii/t, *s©»iswF3Eii*r. shwmj***^©** 

[0197] ^orww^^ujSKvoK^-rs^^T* 
;K4gxe©e^WSK4^K: J: r ** 

R(Xe, v0) = Xe 

[0198] ISHiiC. siw-t^^iittvoccjpf-rs^* 
^jSflEve©««»fl«JHSBE4^iCK: J: o r#*S. 
R(Ve, v0) = Ve 

[0 1 9 9 ] »>tS 1 4 1 1 CCjt*. c = 0, e = 
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0 . p=l, -ecDffeCD&nS-c© Z MP €:0 . *7]Wtfcll£ 

xo= o , vo= o t b -cpgontwimsL vo^mts^ 
rwrnwizztnL. ^mtrji&mxe, urn*?** 

gVe©(ie8tf>!®g£5j?&£ „ 
[0 20 0] %l»TfflJH«9 r Jl'j||£vO tcSft-T*!*** 

R(Xe, p) =Xe 

[02 0 1] ^^-CWW^^UiSSvO K.*tTZ>tei&*: 

R(Ve, p) =Ve 10 
[02 0 2] ^"CS 1412 CCjt*> *»A:fiRS*ijE) 

is i tf m i ?>j©g*# R(xe, o . mi nm 2 ^j©s^ 

#RCXe, e) . m2tf*l?iJ©S^RCVe, c) . $2 
tTm2^J©Ssg*5R ( v ei e) ©2 * 2 'ff^mdE-r*. 
[0 20 3] ^^"CS 1414 &CiI<&. ftf&uMmv) 

mmzm&Zo mimoim 1 tf^ 1 5>j©g5R«. 

* irJl/{igX e&t*hr & 7 ^ - # c ® flHR^jSa R 
(c, Xe) . m2ftmiW<DWMl*. l&ia^eT^KigXe 
e(Dil^W^KR(e, Xe) . Jfll 
tf»25lJ<Dg^«, ^^T-'^jiaVetC^-r^/^^ 20 
-dfc©«at»fl«HBKR(c I Ve) . IP 2 ItIS 2 ^©^Si 

[0204] ^^"CS 1 4 1 6f£'l'v£0&cy-fe;, h 

brx^-hs-a-, si4i8, si 42 04irsi 

U 55E2ft-5££ttS 1 4 3 2tCjttfi^fC. «J£S 
nSttBS 1 4 2 4, S 1 4 2 S 1 4 2 8iC 

i&*,-c*&s©»&*fT5. 

[020 5]i38^n--^t-h^#lLrf©# 30 

«o«^«isi*«iiH-rsi. s i so otcjaorfiewr© 

0. flb©3gft©}&J&£l5ltttc. zl^^^^-^^* 
1 5 0 2KMA,-Cim*S*Wm±.totiL 

aSi©HAxO, AvO, AXe, AVe^Jfrfc-S. 40 
[02 0 6] l$H,*XS 1 5 0 4tCii# t ^r^omm®. 

I-ag*AxO,AvOiL, ZMP^rO il/fcJS-^-© 

KttfftS-iSftAXse, AVse^r^SCCC.fcO^-S. 

AXse=RCXe, xO)* AxO+R (Xe, vO)*AvO 

AVse=R(Ve, xO)* A x 0+ R (V e, vO)*AvO 
[0 2 0 7 ] ^>TS 1 5 0 6tCjt*. ZMPA^^- 

^©ffliESAc, Ae^MK<fcot*J&S. 

Ac = R(c, Xe)*(Ax+AXse)+R(c , Ve)* 

(A v +AVse) 

Ae = R(e , Xe)* (Ax + AXse)+ R(e , Ve)* 50 
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(A v+AVse) 

[0 20 8 ] ^Ut?S 1 5 08KI^ZMPa-7>- 
5*c, e£S 1 20 8-CfflWc©i|S|WK<tottfe 
fe>ti367a--ft-KDS 1 430. SI 
4 3 2£if£-CS3 9 7U- • ^ + - hfcil*. S160 

ofccto's 1 6 o 2vm4<omm<Dmmtmu<Dnm.'k 

tfo-CS 1 6 0 4(Cjt*. ZMP«ijlMiEfi?:**S„ 
cn«. 132 SCCtel^T^^-^c = Ac. e=A 
e, •e©ftfe©^©ZMP©(B^0iL-/c>'^->-Cab 

[0 20 9 ] ^>-CS 1 6 06 tcji*. ^MJlWftM 
• ilK* xmdl(0)=AxO, vmdl(0)=AvO<!: ZMPmdl 
£bT±iBZMP^l*IES£A?Jl/. ^Jl-©^ 

m -a t ) oiiLm. • m&t^m mmt) ©zmp«i 
@ mm t ) ©&g • jis^*-*,. fao, sw©*>j® 

JlWCti. *f*;U©4-|5I©firg . aft* xmdl(0)=Ax 
0. widl(0)=Av0i-r€>„ ffi. atfWfc-t^MCtt. 3Sft 

[0 2 1 0 3 -X^VS 1 6 0 8CC^-C^JCtCS£-o-C. 

x(k) = xmix(k) + xmdl (kA t) 
{SL. x(k) : B«Lh#<&« 
xmix(k) : Ste$^±fHNmX*l©k»9 r --* 
xmdl(kAt) : B$£lJkAt©-fcf^Hig, 
[0211] »5©IQfi©»S8tt±ia©*P<*BRl/)ftC 

i *> 6 . m 4 ©juss©j&« 1 mm<Dm&*n & c £*>-c 

[0212] i f)*ft^(C«^0eiS:}l^-t7-*JU?:ffl^ 
fcCi*>6. (ROM8 4) ©gS^ll^-CE. 

d . z^caiffiGc ifc j; ->t to-r^fetms-c r * * ^ 
©^Tvi/^ttsgmpa^mfcfc&^ft. c©«sw*>6 

[02 131(89. ZMP^-^^-^CC^-rS^i^ffi 
«-i»K©JBttl*«af<W«:J:or*a)6tiS*J. MfclW 
tt«**^-cc»-5©-c. ^F«>-5-©ffl***riBtf.L/r 

[0214II40 «C©#MB©3T6 ©Hj6©fl?aS£in 

[0215] fc«:«>M*ifc#. WJWiiWS¥(4g. K« 
jSWS¥&g i &««l3-l*r4>. ZtiK. &te& 

■c^^js^-. •r^ct>%zMP^^^^^<!:^bl/i^c^^s^ 
tc«. ^©*fiS*BBSft-r-5ci*5rss„ m6o>n 

[0216] c©Bjffl#-c^«-rs#s-c«. msmm 
! l xmm&mi& u tmrs v$><o. -?•© t « z m p 
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zMP^y-**SE;t.5s&wMct»ai. was. 
z m p ~><oitj)Mtz.m&V)Mj&ws.¥-ti.gi ■ mm<D 

Wi£WJS¥<ig£^*££i*«. ZMP^*->4>^M 
[0217] fcTF. ?7Jffiii)BlS^(a!S?r^x€>^i ZM 

mm t <Dtmg.icM&z x mm? z> . io 

[0218]I340:7P-- ^ + -h(C*i(.»TS 1 70 

o*>6si7i o£xm5<Dmm<DBmtf5im<Dmmz 
iTsni 2(cjit?„ m6<Dmm<Dmmxim^m 

¥&%&*m& ZH&tcitolc. ZMP^2->©^IgCC 

[ 0 2 1 9 ] IP^. S 1 7 1 2 &C*st,>-a;t04 1 t£7jk-? 
cfc^CC. B#^lJ0(C*JW?,ZMP©fii^pi-r'5<!:^C. 
ZMP^7J<-$©rttcieip5;, c = 0, e = 
0, p=l. ^©ffe©«r*-C©ZMP©fiI£0. ttJ»M£ 
m*x0=0. v0=0it,T, $&©ttffl$$fS-Cfi9IMb 20 
jj^rJMDmmZstWL. ^iSS^-f^MigXe. 

[0 2 2 0] ^^-CZMP^^^-^pfC^f-r^^^: 

R(Xe,p ) = Xe 

[ 0 2 2 1 3 lUfiHt. ZMP^-^y-^pfcSt-r^,^ 
R(Ve,p)-Ve 

[0 22 2] Ml>T S 1 7 28 $-C2r5©HS6©fl5Sg£ 
PI«<D^a*tfl»> S 1 7 3 0 K:jIA,-C*£g©*i^£fT 30 
5„ HJ%. 0427P-> g 1 *- h©S 1 8 0 OGCtet,* 

tit. g & ffitc ia c © & ^ - x <t L/ r ii^ -r -5 . 

[0 22 3] flU ^-X#S£iStRl/fc&. ttJW±f* 
{£g • itK. **S±f*fig • as, fflffiiB*P£¥ttS*5 

s. sfot. fljjw±<*aa • ass. m®±#®B-m w 

[0 224lMl»TS 1 8 02, S1804 ©MS^rig 

rs 1 8 o 6(cjt^. mmmm^ik&^mtm^ 

3„ fe^S 1 8 0 8&C3i^^;U<D#JWZMP£A 
Pit. *OffeOJT*-C<D ZMP^Otl fcW^-©^ 
(4S • aKAXpe. AVpe£:*5X;(Cj:'3#&&,, 
AXpe=R(Xe, p)*Ap 

AVpe=R(Ve, p)*Ap 50 
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[0 22 5] Il,>tS 1 8 1 OOCMA-CZMP^-^^- 

^©JflESAc. Ae^xs;(cj:-,r*i*5o 

Ac=R(c, Xe)*(AXe + AXse+ AXpe)+ R 
(c , Ve)*(AVe + AVse+AVpe) 
Ae=R(e, Xe)* (AXe + AXse+AXpe)+ R 
(e , Ve)*(AVe +AVse+AVpe) 
[0 2 2 6 ]^l>tE407a--f t-hKIf), S 

1 7 3 2{c^-ea«.^©^5y-£&c±ga®-££;g: 

©;<7>- SPRATS, fib. ZMP^7^i-$c, 

ecc«. s i 8 i zx&ibtcmzRA-tz, ttc, mm 

[0227]iUtS1734*^@437a--ft 
-KCil*. S 1 9 0 0. S 1 9 0 2Xm5<DmM<DB 

st»fcZMP*aw*» 6ns, ^-cs 1 9 0 4Kit 

ZMPfiS^IES Ctl«i4 4iC^Tin 

<. 'i5^-^ c =Ac, e = A e , p = Ap, 
©St*© Z M P ©fii 4 0 £ L Z M P >< 2 - > f * 5 . 

[ o 2 2 8 ] ft. ^©^«. m5<omm<ommtm 

[0 2 2 9 ] *6©36*6©3B«B±8e©«P< KlJSROfc© 
■C, »4ttl>LSB5©^©«M^R^S&#<&S4c 

S8»*SiL-cettL.r*j<£**Jai,»©-c. feti^s 

[ 0 2 3 0 ] 04 5 IZCOmWomi <D9m<D&1&*7jk 

<D-7u-;t>mxfrh 0 flu ^7©HS6©^jSr«±i* 

[0231] ^7©^©^jgtc*jc>r«. f#e>nfc4- 
la (b#sij t ) ©s^?§©ws¥©fiia • mm, zmp 
feicn^ss z tmm (mm t -a t > ©«ss (±» 

t + ^vr- fi/Xi #ffiJ6j^SC. flj^^f*^^ 6 a s ) 

w-mm (x. y) ©^@tf (mmm) ^ma-r-sjr^cc 

[0 2 3 2] BP^, Sff7©HJ£©7$&{Ctel,»-rtt. ®2 
©^S6©ff^i|5]«iC. i467Q--f + -I-OS2 
0 0 0J&C»L2 0 1 4^e.S4 77P-'?f-h©S 

2 1 00&l»OS2 1 0 4©MI i &gri4 

S 2 0 2 2*604 8©S 2 2 0 OfetF^tCji*. S2 2 
0 6«C*Jl>-C®^^©±f*iS^§©S¥©«»l* 
6*b77^W(CltS[ ItiSZMP *S^*^f© ZMPa'7 

>-$*e,tftf>rii,igzMPtc- gc-r5«fc-5K. m 

**S©±«*a*ayc»»tc J: -or*i6€> J: ^KO 
[0 23 3 ] fib. ^gfiJJWt?^. ±(*©{4S • ilSfC 
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-rs. BP*i. 1 **©#§«. w^±<*{4s • m&^^j 
ctic£-?x#ibt>tiz. 

[ 0 2 3 4 J C©#S-C«. ?S»fi*s^< . **J&±<*{i 
[ 0 2 3 5 } ft. »7<E«iSO»»K:*Jl>r. ^@©± 

mm&<Di%Mttmmt£m&?z£5t l c*®-T:i>&i<K io 
t*ja«flBK:^:*<^fb"r*cttt«c«,>i<RSLr. gtia 

[0 23 6] C©<fc 5{C±tBl/fcSfn ft(,>Ugl7©ilS6 

(Df«fei>t, 'ptz < i &±<$2 4i. ffim±mcm 

0510. 12, 1 4R (L) ZftLXm&2tl&W$l* 
©JSPgfl >j>?2i*645 Ws^Sbn * » h ©#§£/£ 

-eti^jg^fciiB-r -5 ^ - £ &^t* a - % <DMcj 

6 ft £ ttmogift&g & iBtt? £ SHB^SSBttHMSi 20 

(sioftt) . ^{cra-r^^^?f-5^g*#© 

(S2 4ft£) . *jJ:Cfflira^S«:R|-r*B*«:Stor 
tufatisi^sr i fi&ots&RfflSftu urieawofc 

ttl&S*S<ciB1KatfttfT -5 c tic cfc 0 . HMlB#^{C 

(S26i5:l,>US3 0, S 1 0 O^OS 1 06, S2 
0 0ftl>LS2 0 6ft<!:') £«;i&£P< tSfSCfc. 

c o 2 3 7 3 titsg&g&i$,&st&> BtriaiitRLfc 

*S*ftIS¥i*lL/rMEifi<6^S**a>i (S100% 
l>t/S106, S2 0 0ftt,>LS 2 0 6ft£") fcKfltofc 30 

[0 23 8] WE*S*RS#S«. fflrfBjlfRL/fc 

(S 5 0 0, S 6 0 OftOOS 6 04. S700^^ 
S7 0 6ft£) tm<ffif&htc. 

[0 23 9 ] ttc. BifBBi#g£fiS#©«> BufBil!«U/c 

-f «K*fllC»-CfJKifi<H*S*3iW)* ( s 8 o o , s 
9 0 0ftt,>OS 9 0 6, S 1 0 0 OftOOS 1 0 0 6ft 
£-) tlB<m&lstc. 40 

[0240] ttc, me&sazg&mt. m&Mm&g 
©4>ft < t & i micr}^x^<Dmimw.m^tc<o ©ffe© 

##>-cfatrr siatt.*© ( s 5 0 0 . s 8 0 0 ft <tr> % 

fBfi<K*i^£3j<it>££p < tft JiSL fc„ 

[0241] *fc. wie** 
m^<Dmm.D cc mi- & / n- 5 * - ^ tc*t-r s -e ©<&©; ^ 
s-f<Dmmo)m{&&mi-?ztim^® (si 104a 
ous 1 1 1 4fti-) Huie^jss nfc«t6cr>B8 50 
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4>ft < t 4>g£{iteJ: -5 J: 5 (cfflrSE#g«: 

ug-rss^^s-rs^^fiK-rs (s 1 1 2 8, s 

1 2 0 0^US 1 2 0 8) ta<W0iU1t. 
[0 24 2] £ fc. Bilfe^CDfdJ©^ ^ - * ©tff i&*s± 
&©*¥{4g©SllHj-C.£>Siq< 

im< m& Ltc 

[0 244] Sfc. BflfBM^ffilAd&T-^^^-C^lS 
[0 24 5] *fc. griBM^I«»?»Jfl|-C*3H3tl4SP 

[0246] ire*s*jss#ia«. iraafcK&K: 

lITf S^7^-£rt^S©*mc£>S<!;tf{;S:. -?■©;•< 7 
^~2£l£{4LTMia£{«^g£*i&& (S 1 7 3 0. 
S 1 800^1S1812) iP<flto£Ufc„ 

[0247] i/c. «HB*s*fiS*a«. miasms 3 n 

Bft&nm^®. (s 3 0 2 ) . te^vmrnztitcmwipi 
ft s <fc ^ {cb-tibp *k » h ©msb^ jgsbw-r ^.wsis 

WW»*K ( S 3 0 6 ) ^r«x^*P< ^fiKU/c. 

[0248] ifc. mrie^gpftS^^ls«. Husan^K 

h ©Kffl«%tfttHr &t£Hi3Ma: (S300, S400 

Buiea*^ h©fi«*jj:ci t aa**«uE-rs«tE*a (s 

4 0 8) *fiA. Buta^gi5ftlS#W^I2«, ^iESti/c 
{4gfc-ct S>*«^ ift-5 <£ 5 (ChmIB o # ^ h ©HflSftK* 
#WfSiP<«^Lfc 0 
[0 249]^, ±IBbfcm ftl»U»7©!8te©JBtt 

[0 25 0] &tc. ±ULtcm 1 ftt,^ l>m 7 <D9m<DB 

site *>-c > r . w±{* 2 4rt<D*s mm& 
mmm&fr wsw-cieaso rt»* . c ©«ag*«^ 

rSjcc^ur«Ji{T©J; >>ic&r2fr<D&Mmwi!bZ>. 
aseai) ±(*©s^ccg:s-r-2> 1 fti> 7 ©31 

Jfe©^S§t?ffffl) 

IS5£&2) ifi3il«{C^flaBi|>ttlBi-SrrSJ:^fttta 

^s^3 ) wffttKccfcor. iiaft{4gccs;^-r-5„ 
[0251] c^-rnw^^sc^rSfflurfe. ±*©(S] 
©JS^-ccttS*^ i; ft c>#. 

4 9 icfji-r «fc 5 K. ^«S*i^[^tc^iij$ -tf ft*5 

S*»**5±(*©^{c&^JS^i, piSF«3«:A4J!&&i 
■C«. BB6^{c±l*©fil[gra»*^d:-,r^-SCi*^ 
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[0 25 2 ] (g^ifrg) ££j$-<rSBgfc:. 

[0 2 5 3 3 ge->TSif &S-<< «j*^¥SKfefl= 

tcztrzmmi&'bs < &s j^cctasESfts-^r * 
■2>„ ±ie©ta^i£©t,>-rft#gj§-c$>sa\ $/c«. c> 

m-C^-oT^^^t^tt. Utf v h©fltS«^f© 

Si±^{cJ:S 0 io 
[ 0 2 5 4 3 Etc. Wj^^^OfflS^r^-Sfcs!) 

[0255] s/c. ±ie(c*j^r. $^7^-$^ 
#£j&3nsc£«m^g-cfcftt>o 20 

[0 2 56 ] gfc. C©:%BJi£2£^tfD# * RC^O 
[0257] 

-Ci*S. SRRStiA:#Sig±©«tlSi«:*jl,»rciiK 
? h ©&g|5{i©^{i:te <fc O'jUK^SM i? -fr S C # 

[ a 2 ] 0 i tc^-r 2 s^tf a * ? h ©*«® j.- 
i^iffl^^-r^P » ^0-c&So 

[03 3 C©»WK«S»SC£ttci#? h©^g^^ 
[04] C©^K^SW^«lP# y h ©*£g£>&l£ 

&<Dmt%fnlr J ■<> -7a-'ft - f-r*S. 
[05] §3feiO : i4©$§4«^-Cftfflt5S!| 40 

[0 6 ] 0 5©!&O«!^§©JS¥&K*£^-r£-f 5> 
y . ^ + _ hf^So 

[07] 05 ©SS0 «***#§© Z MP (X&tl) ©5^ 
[08] H3*J«fcCKH40^f&ia»ff-Cttfl|-r4«fll 
9J0-CAS. 

[09 ] 08©f&l «!iM©ZMP (X)®§) ©£>f 50 
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5 >y ■ h-e*s. 

[010] 03*sj:o'04o*if^iSci!j^rffiffl-rs^ 

3MB0-C**. 

[011301 0©SH2tg|i»&:g©ZMP (Xffiti) © 

[01 2 3 03*sJ;O'04©$^«;«)^-rS*$n/-c 
^^©J^WfirSfc «fc U'-gm % Ui^ 0 -c * S . 
[01 3301 2©g#*#g©ZMP (X&ttD ©£ W 

[0 1 4 3 • ^ + - 3-©*©#f«tef¥** 

jtk-?*)~?)l>-?> ■ ya- • ? + - h-C*So 

[015 3 01 47D- • ^t-- h©«jfP?rlftBJ-rSSi 
BJ30-C&S. 

[016301 5tmm<>cmi 47P--ft- h©s& 

[01 73 047a- • ? + - h©«£©@*i;>££?©8BB$ 
<B»fflft*£^Trif7'n,-?> -7a--ft-hT* 
S„ 

[01 8 3 03te<fcO*04©^^R8ll^-C^S$nfc 
3>7"^ -rr>xftij®©^ a- • h-e#>So 

[119] - ?t- h©tfi©MW3>^'^ 

[02 o 3 c<Dmw<Dm2<Dnm<DBmt,c%zmm<D$h 

ittTjkT, 04£|Sl«©y ^> • 7P- • + - h-c* 

s= 

[02 1 3 02 070- • + - K0tf©*3gfi^fBi 
[0223 02 0 7 0- • ? + - h©cfJ©g^§©6^ 

*So 

[02 3 3 C©#SE©SB3©HS&©ff^cfliSiSK©8lJ 
fP^r^-r, 04£l5l1f©;< Y> • 7P- • * + - h-c*> 

So 

(02 4 3 • 5=-+. - b<D<P<Di&&m&1!m 

[02 5 3 02 3 v a- ■ ^ + - h©4>©B«^©^ 

[02 6 3 C©»W©»4©3lifi©^««:»SSa©«i 
f^^-r. 04£[5|«©^H'> • yu- • h-c* 

So 

[02 7 3 feffio>mM<DBmv£f&2titc±.fc{&mrj:±' 
[02 8 3 02 6 y a- • + - KDmtlctettzmft 
- l~T*S. 

[02 9 3 02 6 7a- • 9 + - h©ttf¥©«f^«rttW 
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-r&zMP (xmm) ©w 5 >y • ^ + - h-c<&£„ * 

[030] m&iCM 267n--ft-h ©»f|P©»f¥ 
[031] m&icm 267a--?t-F ©ttfli©^ 

[032] [aj«(c0 267n--ft-F ©ttfltfDttfe 
<HJMITr*ZMP (XffiHD ©£-f$>^-5^-h-C 
£>S„ 10 

[@33]a267D--?t- h©*©*SS^fPISI 

[03 4] 02 6 7 n- • ^ + - h(Dtfi(Dag$g©K 
[035] 0267H- - h{C^-r^4©H*t© 

[03 6] c<D¥tm<Dm5<omtaommic%imaff>» 
ft&nit* 04<fci^fil©y-r> • 7a- • g 1 *- hr* 20 

So 

[03 7 ] l|l5<DSIMl0^flrcttfflt-«AiaR?«5 s ^ 
©^0-c*-5>o 

[03 8] i367n- • * + - h©tfi©*fc§ffl£fBit 
fc^rTlf itOU-^ • 7D- • ? + h-C#>£,, 
[03 9 ] I3670-' ^ + - *•©#©§«*#§©!» 

[04 0] C©fPJJ©^6©f|^©B!8K:&S$lg©S(l 
fl^jST, 04 tmW<DM 4> • 7B- • 5=-+- h"C* 30 
4. * 
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[04 1 ] 1407B- • ^ + - h©J85©!DS£©J&8& 
[042 ] I407O- • =F + - h©*©^^Hl^^ 
[143]@407a-^t- h©4«©@lS{i#g©l» 

[044] 04O7P- • ?*-t<Dm , Ezmw?z>i> 

[04 5] C©&B©«7©3«fe©J|2ffitCffiS£eiK©fll 
fiUteiO'Sil^t. 03 iiHtfi©:^ ? zmvibZ. 
[04 6] » 7 ©*»©»««: Cfi*»B©ttf^*m-ry 

• 7D- • h-C*)4 0 
[04 7 ] 04 4 7 a- • ^f- h©tt>©*SHB^* 

[04 8 ] 04 4 7 a- • 3=--r- h©^ 1 ©^^^©^ 
[04 9] C©»HJCC^4W^^«JU#^ h©^^fiS 

0-e*£o 

[#^©lftBJ] 



1 

p>K» h) 
2 

10, 12. 1 4R, L 

1 6 R, L 

18, 2 0 R. L 

2 2 R, L 
2 4 

2 6 



[05] 



[06] 



[07] 



E3- 



o=a0 \, 



X (It) 

in* 




Yw 



: cO / 

"if I t3 n 



* 



(20) 



WHPF 1 0 -86 08 1 



mi] 



I / 



26 



i i 

! ! 



,24 



i& A 




[08] 



IM9] 



□ 



•XCtt) 



tea 



tl t2 



25 



v 80 



Q2 



72 
,54 



ROM 



.74 



RAM 



M 

el / 



[016] 



70> 



A/0 



86 



D/A 



[010] 
b2 



Y (£) 



^ 7] - x (|U> 



Yar 



[011] 



c2 

tlt2 



t4 



d2 



(21) 



ftmW- 1 0-86 0 81 



(S3 ] 



a, b, etc. 



n 

(x.. y) •. 
<D$£?ljr-5 g(t) 



flat 



xb. yb, 
exb. ayb. 
iezb 



xf, yf, zf 
exf. flyf. 
fl.zf 

±#zb 



ft* 



ZMP 



f(t) 



ZMP 



7> 



3 



[012] 



[013] 



|3 



Y(S> 18%% 



•X (tt) 
Il%» 



» 1 ttB c3 



t4 




(22) 



nmw- 10-86O8 i 



(H4] 



( START ) 



SJO 

1 



S!2 
A 



t = 0 



S16 
1 



CO 



( END ) 



S18 



i) 



S£0 
X yes 



t = o 



S24 



4- [a ^ # © se ^ is ^ A* 5 > - 5> © 



S26 
— »■ 



S28 



t = t + At 



■S30 



S3-? 



C23) 1 0 -86 08 1 



Cm 



[014] 



SJOO 

— I — 



4- 



5/04 



£ £ ^ $ © ft & K £ a' 5 > - 5 c £ * 4 ft A ft 



^S106 



(return) 




(24) 



nmw- 10-86O8 i 



[017] 



( ENTRY ) 



S200 



S2 ( 02 



S2p4 



S2<?6 



© m £ # £ ± # * ¥ & « £ n tu ? § 



(return) 



18] 



( START ) 



-S300 



□ ;1?>yh©fI££&aJU 1$££^<fc-5C -S304 



[gjs*Bilfei£i::&%£tt5 -~ S306 



(return) 



(25) 



ftmW- 1 0 -86 08 1 



im 1 9 ] 



S400 



S402 



5jgg 



(return) 



[H2 8 ] 



Xac» 



t6 



[§32 ] 



[029] 



ACCfcftZMPfflJES 



AC 

t1t2 It3 t4 t5t6 



RmJxUfls), c)*Ac 



ZMPMjE* 



Rmix(x(k). vO)*AvO 



Ae 



-H l l| .11 



tl XZ t3 t4 t5 16 



BlS!(k*At) 



»«l{k»At) 



(26) 



ftm¥- 1 0-86 08 1 



[02 0 ] 



(start ) 



S500 
i 



■S502 



t = 0 



S506 



00 



C END ) 



S504 



i 



S510 
J_ yes 



t = 0 



S5/2 



S5/4 
_J_ 



_i 



A* 5 ^ - 5> ( - 7" * ) c ^ftvrs 









— 










t 


= t + At 







[030] 



Ae 



tlt2 t3 t4' t5t6 



Rmix(x(k). s)*A8 



85»<k*At) 



(27) 



f$B§¥ 1 0-86 08 1 



[02 1 ] 



( ENTRY ) 



& 16 £ / s* 5 ^ - 5> © <i A*£ * ft iz j£ t» 



—S604 



(return) 



[03 1 ] 



[03 5 ] 



ZMP»3E» 



Rmix(x(k), x0)«Ax0 
XO 
0 



AC 



a m ts te 



[037 ] 



S3*<0#S0)ZMP 
few 



c c+4c M e »+Ae . M 



±#tt» 



Si^t* o 




#<S(k*At) 



xmixflO **(k*At) 



x(k) = xmix{k) + Rmix(x(k). c)*Ac + Rmix(xtk). e)*Ae 
f Rmix(x(k), xO)tAxO + Rmix(x{k), vO)*AvO 



±#24 



vO = ✓ g 7 h 




-ZMPmdl 



(28) 



1 0-86 08 1 



[02 2 ] 



( ENTRY ) 

: _i_ 



S7ft4 



— J- 



cd >i ^ # & ±# ?K ^ & n *n tu 



(return) 



[S3 4 ] 



( ENTRY ) 



■S1304 



(return) 



(29) 



ftfflW- 1 0 -8 6 08 1 



[02 3 ] 



( START ) 



S800 



1 



* ? 5 y r ft ja u tz m m & * t itu-eaK 



t = o 



5806 

Jl 



( end ) 



.5804 



5808 



58K5 



yes 



t = o 



58/2 



58/4 
i 



58 } / 6 



58J8 



§ e * ® © m h» fi * w v zr ii — 9 y 



t = t + At 



-S820 



5822 



[044] 



c e 
tl t2 1H tjtj t5 16 



AP 




(30) 



ftWW- 1 0-86 08 1 



[024 ] 



( ENTRY ) 



S900 



4 — 



eft 



(return) 



[038 ] 



C ENTRY ) 



S1500 

y 



S/50? 



fccl&AXO.'AvO, AXe. AVe**»S 



ZMPA*^-5>©*j!jEl;Ac. Ae£;£*>5 ~St506 



ZMPa'^-^c, e£3£0>3 



-S/50S 



(return) 



(31) 



[02 5 ] 

( ENTRY ) 

S1000 



S10p2 



WateDiBfiTttlt'aS^fcWrMt-AtflLt^t-. 



siope 

© m ^ * * ± ft tK ¥ fit * £ » tib» ■** 



(return) 



[03 9 ] 



( ENTRY ) 



»*!t<DZMP**»* 



B£2!l top 



-S1600 
'S1602 
S1604 



t © t ^ ^ © § • % j£ £ ^ 9) ?> 



=e t* i i ft g * n iE s t u t ft £ * £ © ± ft & m c 



(return) 



(32) 



ftmW- 1 0 -8 6 08 1 



126} 



(start) 



SHOO 
L 



51102 

L 



S1104 

L 



c, ecM?S±#ti[g©igjaRmix(x(k), c), Rmix(x(k), e)^^fes } 



©$JgRmix(Xe, c), Rmix(Ve, c), Rmix(Xe. e), Rmix(Ve, e)£ 



(Rmix(Xe, c) Rmix(Xe, e)| 
kRmtx(Ve, c) RmixCVe, e)l 



S1106 



\ Rmix(c, Xe) Rmix(c, Ve)| 
A ^Rmix(e, Xe) Rmix(e, Ve)J 



'SW8 



smo 



SW2 
1 



%Iffl±ftteg-gJg©&jgRmix(x(k). xO), Rmix(x(k). vO)^fes 



f:»^J5^©^^EM©<i^6 ; gI^±#ftM-3l^ic^t5^^ 
±#ft»«:&j£©$J&Rmix(Xe, xO), Rmix(Ve, xO), Rmix(Xe, vO), 
Rmix(Ve, vO)£:£D£ 



—f— 
S1114 



t=0 



CO 



SW8 



yes 

SJ122 



tjOj S7724 



SU26 
S1128 



[|gggcggggg?gjrg>I[ --5//Jg S7730 
t = t + At I —— 57734 



(33) 



«fHJ¥ 1 0 -86 08 1 



133] 



( ENTRY ) 



S1200 

L 



S12 { 02 



£©ltAxO, AvO. AXe, AVe£;£»5 



S/206 

— ^— 



^^Hti^^±^1fe^-^JS©^AXe+AXse, aVe+AVse£ 
OlCtSfcfcflZMPA^y-^OlfjEgAC, Ae£*»5 



( ^return) 
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